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Abstract 



The invention relates to a navigation system for a vehicle, in particular for a land vehicle, having at least one 
single-axis gyro for the vehicle vertical axis (z axis), having two accelerometers in the horizontal vehicle 
plane (x axis, y axis), and having a vehicle-axis velocity measurement device, for example, a distance- 
travelled sensor. In addition, supporting signal devices, in particular a satellite receiver and/or a map, are 
available as well as a controller, which uses a suitable Kalman filter to determine the vehicle position and/or 
the direction of travel from the measured and stored signals. The Kalman filter is assigned at least one 
partial filter, of which a first partial filter is used for dynamic levelling and/or a second partial filter is designed 
as a position filter which provides track calibration, position calibration and sensor calibration 
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® Navigationssystem fflr ein Fahrzeug, insbesondere fur ein Landfahrzeug 

Fahrzeug, msbesondere for ein Landfahrzeug, mil waniq? 
stens ainem einachsigen Kreisel for die Fahrzeughocbachse 
mH Z T' B ~^laonigongsmas S ern in der horizon 
talen Fahrzeugebene (x-Achae. y-Achsa). und ainer fahr- 
zeugfesten Geachwindigkeitsmassung, zum Baispi al eh?am 
Weggeber. Zusatzlich sind StutzsignLnnchtuTgen .naba 
™*° T ° *") Satailitanampfangar ond/odar aina Karte ver- 
SS^T "S" Steueruno - di » ™* gemessenen und 
Kkem *. * k ' 8r,alen ? * Hi,,e eines Qoaignetan Kalman- 
bestfcnmt FahrMUflpo8ltlon "nd/odar die Fahrtrichtung 

ll 'Vjt?T S * h * n - t a& dom Kalmen-Filtar (24) wanigstens 
am Ta.lf.ltar zugeordnet 1st. von denen ein e4ter Tailfifter 
e.ner dynamischen Horizontierung diant und/odar ein zwet 
ter Te.lf.lter als Poaitionsfilter ausgebildet ist.der aina C 
I Positions- und Senaorkalibration bewirkt. ' 
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Beschreibung 

Die Erfindung betrifft Navigationssysteme fur ein Fahrzeug, insbesondere fQr ein Landfahrzeug, mit den im 
Oberbegriff des Anspruchs 1 genannten Merkmalen. 

5 

Stand der Technik 

Es ist bekannt, Fahrzeuge mit Navigationssystemen auszustatten, die eine Bestimmung der Position und der 
Richtung des Fahrzeugs gestatten. Die Fahrzeuge weisen hierzu sogenannte lnertialsysteme auf, die mit fahr- 

10 zeugfesten Sensoren ausgestattet sind. Als Sensoren werden ublicherweise den Achsen eines karthesischen 
Koordinatensystems zugeordnete Beschleunigungsmesser und Kreisel eingesetzt Die Achsen des Koordinaten- 
systems sind hierbei so gelegt, daB eine x- und eine y-Achse in der horizontalen Fahrzeugebene lie gen und eine 
z-Achse mit der Fahrzeughochachse zusammenfallt Typische Anwendungsfalle derartiger lnertialsysteme sind 
Koppelnavigationssysteme, Inertialnavigationssysteme und Kurs-/Lagereferenzsysteme. Bei einer allgemein 

is angewandten Kurs-/Lagerechnung werden mittels der den einzelnen Achsen des Koordinatensystems zugeord- 
neten Kreiseln die Kurs-/Lageinf ormationen des Fahrzeugs, beispielsweise als Richtungskosinusmatrix, errait- 
telt Durch Verknupfung der Richtungskosinus matrix mit einer gemessenen fahrzeugfesten Geschwindigkeh 
kann eine Koppelnavigation in bekannter Weise berechnet werden. Die fahrzeugfeste Geschwindigkeitsmes- 
sung dient hierbei auch als Stutzmessung fur die Lagebestimmung des Fahrzeugs. Die derart ermittelten Kurs 

20 und Position des Fahrzeugs werden mit Stutzinfonnationen verkniipft, die nur eingeschrankt verfGgbar sein 
kdnnen. Hierzu ist es bekannt, die Fahrzeuge mit Empfangern von Satellitennavigationssystemen — beispiels- 
weise GPS — auszustatten, die Geschwindigkeits- und/oder Positionssignale zur Verfugung stellen. Alternativ 
kdnnen zur Stutzung auch Positions koordinaten aus Karten ubernommen werden, wobei es fur die vorliegende 
Anwendung unerheblich ist, ob diese Positionsinformationen aus einer digitalen Karte oder einer Papierkarte 

25 entnommen werden. Mittels dieser Stutzinfonnationen kdnnen Positions* und Geschwindigkeitsmessungen mit 
den auf bordautonomen Messungen basierenden Signalen verglichen werden und als Differenzsignale einem 
Kalman- Filter als Beobachtung zugef iihrt werden, das ein linearisiertes Modell der Algorithmen fur die Berech- 
nung der Navigationsdaten des Navigationssystems beinhahet Mittels des Kalman-Filters werden Korrekturen 
fur die Navigations parameter und fur die (Calibration der Sensoren des Navigationssystems geschatzt 

30 Hierbei ist nacht eilig, daB durch die Nichtlinearitat der Kurs- Lagerechnung des Navigationssystems einerseits 
und der linearen Approximation in den Modellgleichungen des Kalman-Filters andererseits fehlerhafte Schat- 
zungen entstehen kdnnen, wenn das Filter auBerhalb des zulassigen linearen Arbeitsbereiches betrieben wird. 

Vorteile der Erfindung 

35 

Das erfindungsgemaBe Navigationssystem mit den im Anspruch 1 genannten Merkmalen bietet demgegen- 
Qber den Vorteil, daB Fehler reduziert werden kdnnen, die ihre Ursache in dem nichtlinearen Charakter der 
Kurs-/Lagerechnung und der linearen Approximation des Fehlermodells im Kalman-Filter haben. Insbesondere 
bei Fahrzeugen mit einem eingeschrankten Lagewinkelbereich, beispielsweise bei Landfahrzeugen, sind Instru- 

40 mentierungen des Navigationssystems moglich, die mit nur einem der Fahizeughochachse zugeordneten Kreisel 
auskommen. Dadurch, daB dem Kalman-Filter wenigstens ein Teilfilter zugeordnet ist, von denen ein erster 
Teilfilter einer dynamischen Horizontierung dient und/oder ein zweiter Teilfilter als Positions filter ausgebildet 
ist, ist es vorteilhaft moglich, Filterverf ahren durchzufQhren, die Fehler reduzieren, die durch das Fehien der 
horizontalen Fahrzeugebene zugeordneten Kreisel verursacht werden. Daruber hinaus ist eine Oberwachung 

45 des Kalibrationszustandes, insbesondere der azimutalen Ausrichtung urn eine durch nichtlineare Effekte verur- 
sachte Systemdekalibration, das heiBt, eine Kurs-, Position- und Sensordekalibration moglich, wobei die Dekali- 
bration erkannt und besehigt werden kann. Sehr vorteilhaft kann hierbei weiterhin das lineare Fehlermodell als 
Basis des Kalman- Filters beibehalten werden, urn den erhohten numerischen und analytischen Aufwand fiir die 
Realisierung eines Kalman-Filters mit nichtlinearem Model! zu vermeiden 

so Weitere vorteilhafte Ausgestaltungen der Erfindung ergeben sich aus den ubrigen in den Unteranspriichen 
genannten Merkmalen. 

Zeichnungen 

55 Die Erfindung wird nachfolgend in Ausfuhrungsbeispielen anhand der zugehdrigen Zeichnungen naher erlau- 
tert. Es zeigen: 

Fig. 1 eine Signalverarbeitungsstruktur eines Navigationssystems mit erfindungsgemaB reduzierter Sensor- 
konftguration; 

Fig. 2 einen mdglichen Zustand des Fahrzeuges; 
60 Fig. 3 eine Signalverarbeitungsstruktur des Navigationssystems nach einem weiteren Ausfuhrungsbeispiel; 
Fig. 4 eine Fehlerschatzgleichung eines Positionsfilters; 
Fig. 5 ein Gesamtfehlermodell einer Hbrizontalnavigation; 

Fig. 6 eine Signalverarbeitungsstruktur des Navigationssystems nach einem weiteren Ausfuhrungsbeispiel; 
Fig. 7 eine Fehlerschatzgleichung eines Positionsfilters gemaB Fig. 6. 

65 

Beschreibung der Ausf uhrungsbeispiele 
Fig. 1 zeigt eine Signalverarbeitungsstruktur eines allgemein mit 10 bezeichneten Navigationssystems eines 
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nicht dargestellten Fahrzeugs. Bei den AusfOhrungsbeispielen wird davon ausgegangen, daB es sich um ein 
Landfahrzeug, beispielsweise cin Kraftfahrzeug handelt Das Navigationssystera 10 besitzt in der Darstelhing 
links dargcstellte b rdautonome fahrzeugfeste MeBeinrichtungen und in der Darstellung rechts dargestellte 
MeBeinrichtungen, die zeitlich eingcschrinkt MeBsignale zur Verfugung stellen kSnnen. Als fahrzeugfeste 
MeQeinrichtungen ist ein Weggeber 12, cin einer Fahrzeughochachse, hier als z-Achse definiert, zugeordneter 5 
einachsiger Kreisel 14 und der horizontaJen Fahrzeugebene jeweils in der x-Achse und y-Achse zugeordnete 
Beschleunigungsmesser 16 vorgesehen. Der Weggeber 12, der Kreisel 14 beziehungsweise die Beschleunigungs- 
messer 16 Kefera von dem jeweiligen Fahrzeugzustand abhangige Signale, die in npch zu erl&uternder Weise 
einer Koppelnavigation 18, einer KursVLagerechnung 20 und einer Geschwindigkeitsberechnung 22 zugefOhrt 
werden. Die Kurs-/Lagerechnung 20 tiefert anhand der von dem z-Kreisel 14 gelieferten Signale eine Richtungs- 10 
kosinusmatrix Cb r » wobei durch das Fehlen der x-Kreisel beziehungsweise y-Kreisel die diesen Achsen zuzuord- 
nenden Drehraten von einem Kalman- Filter 24 in noch zu erlauternder Weise als Sch&tzwerte geOefeit werden, 
Die Beschleunigungsmesser 16 liefern die in der x-Richtung beziehungsweise y-Richtung auftretenden Be- 
schleunigungssignaie an die Geschwindigkeitsberechnung 22. Die Beschleunigungssignale werden zuvor flber 
eine Coriolis-Korrektur 26 (in fahrzeugfesten Koordinaten) abgeglichen, um aufgrund einer von genau rait der 15 
x-Achse, y-Achse beziehungsweise z-Achse abweichenden Bewegungs- und darait Beschleunigungsrichtung 
ausgehende Coriolis-Beschleunigungen berilcksichtigen zu kdnnen. Bei dem AusfQhrungsbeispiel wird davon 
ausgegangen, daB aufgrund der Erddrehung induzierte Coriolis-Beschleunigungen vernachl&ssigbar sind Die 
Coriolis-Korrektur 26 verarbeitet hierbei die von dem Weggeber 12 beziehungsweise dem z-Kreisel 14 zur 
Verfilgung gestellten Signale. Da durch das Nichtvorhandensein der x-Kreisel und y-Kreisel von diesen keine 20 
Signale bereitgestellt werden kdnnen, erfolgt die Berechnung der Coriolis-Korrektur des Fahrzeugs entspre- 
chend der nachfolgend aufgefQhrten Matrix: 



Durch das Nichtvorhandensein der x-Kreisel und y-Kreisel vereinfacht sich die Matrix zur Berechnung der 
Coriolis-Korrektur fur die fahrzeugfeste x- und y-Achse in folgender Weise: 



Die Geschwindigkeitsberechnung 22 berechnet aus den derartig korrigierten Beschleunigungsmessersignalen 40 
die inertiale Geschwindigkeit Vins des Fahrzeugs. Diese inertiale Geschwindigkeit wird einem Dif ferenzglied 28 
zugefuhrt, dem gleichzeitig die vom Weggeber 12 gelieferte Weggebergeschwindigkeit zugefOhrt wird, und als 
Differenz zu der Weggebergeschwindigkeit dem Kalman-Filter 24 als Beobachtung zugefOhrt Diese Beobach- 
tung dient als Lagestiitzung der Navigationsberechnung. 

Anstelle der hier eriauterten fahrzeugfesten Berechnung der inertialen Geschwindigkeit beziehungsweise der 45 
hieraus resukierenden Beobachtung kann gemaB einem nicht dargestellten AusfQhrungsbeispiel auch eine 
erdfeste Lagestfitzungsinformation ermittelt und bereitgestellt werden. Hierbei ist jedoch der Berechnungsauf- 
wand durch den Abgleich mit erdfesten Koordinatenpunkten aufwendiger. Der Geschwindigkeitsberechnung 22 
wird feraer die Richtungskosinusmatrix Cb r und ein vom Kalman-Filter 24 gelieferter Schatzwert der Ge- 
schwindigkeit zugefuhrt 50 

Der Kalman-Filter 24 hat bei der gezeigten Konfiguration der fahrzeugfesten MeBeinrichtungen unter 
anderem die Aufgabe, Schatzwerte der fehlenden Drehratenmessungen in der fahrzeugfesten Horizontalebene, 
das heiBt in der x-Richtung und y-Richtung, zu liefern und diese quasikontinuieriich auf die KursVLagerechnung 
20 und die Geschwindigkeitsberechnung 22 mit geeigneter Bandbreite zuruckzufuhren. Die quasikontinuierliche 
RGckfuhrung der Schatzwerte in den Berechnungsablauf des Navigationsaigorithmus stellt sicher, daB eine 55 
Verknupfung rait der Dynamik der Schatzwerte der horizontalen Drehrate gewahrleistet ist Anstelle der 
quasikontinuieriichen Bereitsteliung der dynamischen Schatzwerte der Drehraten kann ebenfalls ein hierzu 
aquivalenter Schatzwert, beispielsweise die Winkelinkremente der horizontalen Fahrzeugachsen erfolgea 

Der Koppelnavigation 18 werden die vom Weggeber 12 gelieferten Signale sowie die Richtungskosinusmatrix 
der KursVLagerechnung 20 zugefuhrt Aus diesen zur Verfugung stehenden Signalen berechnet die Koppelnavi- 60 
gation 18 ein Positionssignal P und ein Geschwindigkeitssignal V. Das von der Koppelnavigation 18 gelieferte 
Positionssignal P und die von der Kurs-/Lagerechnung 20 gelieferte Richtungskosinusmatrix Cb r liefern die 
unkorrigierten Navigationsdaten, das heiBt die Position, den Kurs und die Lage des Fahrzeugs, des gesamten 
Navigationssystems 10. 

Zur Stutzung von Kurs und Position werden Stutzinformationen zum Beispiel fiber einen GPS- Empf anger 30 65 
und/oder abgespeicherten Kartenpositionen 32 bereitgestellt Der GPS- Empf anger 30 ist Bestandteil eines 
globalen Satellitennavigationssystems, mittels dem Positionssignale und Geschwindigkeitssignale bereitgestellt 
werden kdnnen. Mittels der Karte 32 laBt sich ebenfalls ein Positionssignal bestimmen. Verfahrensbedingt stent 
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die StOtzinformation nur z itlich ingeschrankt zur Verfugung, da der GPS-Empfang gestort sein kann, bei- 
spielsweise durch Abschattung, oder Kartenpunkte als Stutzung nur dann vcrwendbar sind, wenn diese im 
G lande identifizierbar sind. # 

Die von dem GPS-Empfanger 30 beziehungsweise der Karte 32 gelieferten Positions- und Geschwindigkeits- 
signale werden Ober Differenzglieder 34 beziehungsweise 36 mit dem von der Koppelnavigati n 18 gelieferten 
fahrzeugfesten Positions- und Geschwindigkeitssignalen verglichen und deren Differenz als Beobachtung dem 
Kalman-Ftlter 24 zugef Uhrt 

Der Kalman-Fdter 24 basiert auf einem linearisierten Modell der Algorithmen des Navigationssystems 10 und 
hat die Aufgabe, Korrekturen fOr die AusgabegroBen des Navigationssystems 10 und fOr die Kalibration der 
MeBeinrichtungen des Navigationssystems 10 zu schatzen. 

FQr die Schatzung der f ehlenden Drehratenmessungen in der fahrzeugfesten Horizontalebene ist eine Anpas- 
sung des Kalman- Filters 24, das heiBt eine Festlegung beziehungsweise Ordnung der hierfur notwendigen 
Fehlerzustande moglich. FOr eine bevorzugte Anwendung wird das Kalman-Filter 24 hierzu derart modifiziert, 
daB die Fehlerzustande Lagefehler (Richtungskosinusmatrix-Parameter), Winkelinkrementfehler und Ge- 
schwindigkeitsfehler, die jeweils der in der fahrzeugfesten horizontalen Fahrzeugebene liegenden x-Achse 
beziehungsweise y- Achse ihren Ursprung haben. Diese sechs Fehlerzustande bilden einen Teilfilter des Kalman- 
Filters 24, das die dynamische Horizontierung als Basis fur die Schatzung der horizontalen Drehraten in der 
x-Achse beziehungsweise y^Achse-realisiert Die Fehlerzustande sind hierbei zwei Lageparametrierfehler ocji, 
OC32, zwei Winkelinkrementalfehler oO^y und zwei Geschwindigkeitsf ehler <rvx,y definiert Die Lageparameter- 
fehler sind als additive Fehler zu den zugehdrigen Rich tungskosmusmatrixelemen ten C31 «* —sin 8,032 °» sin <p 
cos 9, definiert mit <p und G als Roll- und NickwinkeL 

Nachfolgend ist ein diskretes Fehlermodell des Teilfilters des Kalman- Filters 24 far die dynamische Horizon- 
tierung als Fehlermodell 6. Ordnung in zeitdislcreter Formulierung dargestellt 
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Als Beobachtung £V*j ist — wie bereits erwahnt — die Differenz aus fahrzeugfester Inertialgeschwindigkeit 
(von der Geschwindigkeitsberechnung 22) und Weggebergeschwindigkeit (vom Weggeber 12) definiert: 



Av£> « v% s -v B DT = (Av x Av ) 7 
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FGr die Dimensionierung und die Integration des Teilfilters fur die dynamische Horizontierung innerhalb des 
Kalman-Filters 24 gilt, daB im stochastischen Modell insbesondere solche MeBstorungen sorgfaltig zu modulie- 
ren sind, die in bezug auf die Lageinformation im Beschleunigungssignal als dynamische Stdrungen zu interpre- 
tieren sind, wobei die Verfugbarkeit der Weggebergeschwindigkeit als Informationstrager fur die translatori- 
sche Bewegung zu berucksichtigen ist 

Die Filterschatzwerte des Teilfilters fur die dynamische Horizontierung werden quasikontinuierlich in die 
Kurs-/Lagerechnung 20 des Navigationssystems 10 zuruckgefuhrt Im gezeigten Beispiel werden die Fehler- 
schatzwerte als Winkelinkrementkorrektur A0x,y als Drehratenschatzungen fur die in der Instrumentierung 
fehlenden x-Kreisel und y-Kreisel bereitgestellt Fur die Aufschaltung der Korrekturen auf die Kurs-/Lagerech- 
nung 20 sind jedoch auch andere algorithmische Realisierungen denkbar. Nachfolgend ist die Korrekturglei- 
chung als Winkelinkrementschatzung fiir die ProzeBruckfuhrung gezeigt, die auf den Schatzwerten des Teilfil- 
ters dynamische Horizontierung des Kalman-Filters 24 basiert 



4 



DE 195 36 601 Al 



= / 



{ScJ K ' [*,)■' 



Aft 



Nachf Igend wird die Kotwendigkeit der Drehratenschatzung in der fahrzeugf esten H rizontalebene und die 
Wirkungsweise in Verbindung mit der nichtlinearen Kurs-/Lagerechnung 20 an einem speziellen Fahrzeugma- 
ndver nfiher erlautert Hierzu ist in der Fig. 2 ein Fahrzeug 38 schematisch angedeutet, welches sich in etner 
Steillcurvenfahrt befindet Mit x B , y B und z? sind hierbei die fahrzeugfesten x-, y- beziehungsweise z-Achsen 
bezeichnet Der Rollwinkel q> zwischen der Horizontalen und der y-Achse ist als konstant angenommea Der 
Nickwinke! 9 in der x-Achse ist gleich Null, wahrend die Winkelgeschwindigkeit y in der z- Achse des Fahrzeugs 
38 ebenfalls als konstant angenommen wird Bei diesem in Fig. 2 dargestellten Mandver treten sorait in der 
fahrzeugfesten y- und z-Achse stationare Drehraten toy* auf f wobei sich der Gesamtdrehratenvektor o> wie folgt 
darstellen HBt: 
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FQr die Navigation eines Fahrzeugs ist die GrdBe ernes Azimutfehlers bedeutsam. Nachfolgend werden 
Azunutfehlergleichungen fOr unterschiedliche Ausstattungen des Fahrzeugs 38 mit MeBeinrichtungen, insbeson- 
dere DrehratenmeBeinrichtungen, dargestellt Fflr den Fall, daB eine Drehratenmessung in der horizontalen 
y- Achse des Fahrzeugs 38 vorgesehen ist, ergibt sich folgende FehlermodeDgleichung: 



*-<p^+(py 8SF Gy +SSF G j 
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35 



wobei das weiter unten angegebene typische Fehlerbudget 



CO, 



w lAOOppm 



40 



betragt 45 

Fur einen zweiten Fall wird angenommen, daB keine Drehratenmessung in der y-Achse und ebenfalls keine 
Drehratenschatzung in der y-Achse erfolgt Hier ergibt sich folgende Fehlermodellgleichung: 




+ SSF G, 



50 



wobei das typische Fehlerbudget 



55 



CO. 



10.000 ppm 



60 



betragt 

In einem dritten Fall, und hierauf bezieht sich die Erfindung, erfolgt keine Drehratenmessung in der fahrzeug- 
festen y-Richtung, sondern eine Drehratenschatzung in der y-Achse, ergibt sich folgende Fehlermodellglei- 
chung: 
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wobei das typische Fehlerbudget 



&2.2Q0ppm 




15 betragt 



Fttr das typische Fehlerbudget sind als Einzelfehler angenommen: &SF y?z ist der Skalenfaktorfehler des y-, 
z-Kreisels [1000 ppml b y der Bias des y-Beschleunigungsmessers [10 nig] und q> der Rollwinkel [0,1 rad] bezeich- 
net 

Bin Vergleich der FehlermodeDgleichungen zeigt, daB bei einer einachsigen Kreiselinstrumentierung mit 

20 Drehratenschatzung sich der vom Beschleunigungsmesser-Bias abhangige Fehler ira Vergleich zur dreiachsigen 
Drehratenmessung zwar verdoppeh, aber der vom Quadrat des Rollwinkels abhangige dominante Fehler fur 
den Fall der einachsigen Drehratenmessung ohne Drehratenschatzung verschwindet Die erfindungsgemaBe 
Verwendung der Drehratenschatzung bewirkt fur das Zahlenbeispiel eines typischen Fehlerbudgets, entspre- 
chend der genannten Werte, einen urn etwa den Faktor 5 reduzierten Aziinutf ehler fur eine einachsige Drehra- 

25 tenmessung, wahrend der Azimutfehler fur die in Fig. 2 gezeigte Steilkurvenfahrt gegenuber einer dreiachsigen 
Drehratenmessung nur leicht zunimmt 

Das vorstehend erwahnte Steilkurvenmandver ist lediglich beispielhaft So sind bei typischen Fahrten des 
Fahrzeugs 38 durch Gelandekonturen mit sich gleichzeitig andernden Nick- und Rollwinkeln ebenfalls Manover 
gegeben, fOr die die nichtlineare Charakteristik der Kurs-/Lagerechnung 20 von Bedeutung ist Auch bei diesen 

30 Mandvern bietet die Verwendung des erftndungsgemafien dynamischen Horizontierungsfilters als Teilfilter des 
Kalman-Filters 24 mit Drehratenschatzung vergleichbare Verbesserungen in der Fehlerschatzung. Insgesamt 
laBt sich somit durch die RQckfuhrung der Fehlerschatzung in die KursTLagerechnung 20 erreichen, daB trotz 
einer eingeschrankten Instrumentierung des Fahrzeugs, beispielsweise mit der Ausstattung lediglich eines 
z-Kreisels, und von Beschleunigungsmessern in den Fahrzeughorizontalachsen, die insbesondere durch den 

35 nichtlinearen Charakter der Kurs-/Lagerechnung 20 verursachten Fehlern vermieden beziehungsweise redu- 
ziert werden konnen. Der Einsatz des dynamischen Horizontierungsfilters erlaubt eine Schatzung der Drehra- 
tenkomponenten in der fahrzeugfesten Horizontalebene in einer fur die jeweilige Anwendung angepaBten 
Bandbreite. 

1m Beisptel wird von einer dynamischen Horizontierung durch einen Teilfilter des Kalman-Filters 24 ausge- 

40 gangen, das auf dem diskreten Fehlermodell 6, Ordnung basiert Variationen dieses Fehlermodells in bezug auf 
modifizierte Diskretierungsapproximationen sind moglich. Die Berechnung der Schatzwerte fur die diskreten 
Winkelinkremente in der fahrzeugfesten x- und y-Achse kann in Verbindung mtt der Kreiselmessung in z-Rich- 
tung als Eingangssignal fur die KursVLagerechnung 20 verwendet werdea Alternative Formen der Verarbei- 
tung der Schatzwerte des Kalman-Filters 24, das heiBt des Teilfilters der dynamischen Horizontierung, in der 

45 Kurs-/Lagerechnung 20 sind moglich. Weiterhin kann die Dimensionierung des stochastischen Modells fur das 
Kalman- Filter 24 adaptiv gestaltet werden. Eine bevorzugte Anwendung ist eine frequenzband-selektive Bewer- 
tung der translatorischen Storungen in den Beschleunigungsmessungen. 

Daruber hinaus ist eine alternative Definition des Fehlerzustandes fur das erlauterte Fehlermodell mdglich. 
Hier kann beispielsweise eine Ordnungsreduktion auf einen Teilfilter vierter Ordnung durch Vernachlassigung 

50 der Fehlerzustande der Winkelinkrementf ehler oder auch eine Transformation der Lagef ehler, Drehratenf ehler 
und Geschwindigkeitsfehler in andere Darstellungsf ormen erfolgen. 

Der Teilfilter der dynamischen Horizontierung kann auch in dem gesamten Kalman- Filter 24 eingebunden 
bleiben, so daB der Kalman- Filter 24 insgesamt seine Funktion fiir das Navigationssystem 10 beibehalten kann. 
Daruber hinaus ist es moglich, den Teilfilter der dynamischen Horizontierung in zwei Teilfilter, bezogen auf zwei 

55 orthogonal e Achsen, aufzuteilen. Hierbei konnen fur die Filterdimensionierung die Kopplungen zwischen den 
beiden Teilfiltern vernachlassigt werden, wobei aber bei der Realisierung der Schatzfehlergleichungen diese 
Kopplungen als deterministische Eingangssignale berucksichdgt werden mussen. Fur das erlauterte Fehlermo- 
dell hat die Vernachlassigung der Kopplungen zur Folge, daS zwei Teilfilter dritter Ordnung, beispielsweise als 
Nickwinkel- und Rollwinkelfilter, als stadonare Kalman-Filter ausgelegt werden konnen, da die zugehdrigen 

60 Fehlermodelle dritter Ordnung nahezu zeitinvariant sind Fur die Realisierung der Schatzgleichungen ist aber 
die Berucksichtigung der 80 z - Kopplungen wesentlich. 

Im weiteren soil auf ein zweites Teilfilter des Kalman-Filters 24 eingegangen werden, das zur Positions- und 
Azimutkorrektur sowie zur Sensorkalibration dient. Das zweite Teilfilter bezieht sich auf die Fehlerzustande der 
Positionsfehler, der Azimutfehler, der z-Kreiselfehler (Drift, Skalenfaktorfehler) und des Skalenfaktorfehlers des 

65 Weggebers. Das zweite Teilfilter stellt somit einen Filter 6. Ordnung dar und bewirkt eine Kurs-, Positionskor- 
rektur- und Sensorkalibrierung. Dieser zweite, nachfolgend als Positionsfilter bezeichnete Teilfilter des Kalman- 
Filters 24 kann auOerhalb des zulassigen Arbeitsbereiches seines linearen Modells bei einer Erstinbetriebnahme 
oder einem Fahrzeugtransport mit ausgeschaltetem Navigationssystem 10 bedeutsam sein. Durch eine Oberwa- 
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chung des linearen Arbeitsbereiches des Positionsfilters ist eine automatische Initialisierung des Positionsfilters 
mit den zugeh6rigen Fehlerzustanden, fOr die eine Initialisierung notwendig ist, mdglich. Hierbei sind die 
Betriebszust&nde des Positionsfilters, n&mlich die Betriebszust&nde Fahrt des Fahrzeugs und Stflktand des 
Fahrzeugs zu unterscheiden. Eine Erkennung des Fahrzeugzustandes kann durch einen Oberwachungsalgorith- 
mus der einzelnen MeBeinrichtungen des Navigationssys terns 10 erfolgea Auf die Erkennung des Fahrzeugzu- 5 
stand es soli im Rahmen der voriiegenden Beschreibung jedoch nicht h&her eingegangen werdea 

Die erfindungsgem&fie Fehleranalyse basiert auf einer transformierten F rm des Fehlermodelb des Positions- 
filters, also des zweiten Teilfilters des Kalman-Filters 24, mit folgenden modifizierten Fehlerzustanden : 
Die P sitionsfehler werden von einer erdfesten Darstellung Sq> und 6X in eine auf die Horizontalebene projizier- 
tefahrzeugfesteDarsteUungSpxjrtransformiert 10 

In der Fig. 3 ist das Navigationssystem 10 in einer wetteren Ausfiihrungsvariante gezeigt, wobei gleiche Teile 
wie in Fig. 1 mit gleichen Bezugszeichen versehen und nicht nochmals erltutert sind Zu der in Fig. 1 gezeigten 
Ausfiihrungsvariante ist zusatzlich ein Transformationsglied 40 vorgesehen, das die dem Kalman-Filter 24 
zugefQhrten Beobachtungen der Position AP und der Geschwindigkeit Av Qber eine Matrix in ein fahrzeugfestes 
Koordinatensystem transformiert, so daB die mnerhalb des Positionsfilters bereits in die fahrzeugfeste Form 15 
transformierten Fehterzust&nde auf ebenf alls in die fahrzeugfeste Form transformierte Beobachtungen zurOck* 
greif en kdnnea Hierdurch wind eine weitere Vereinf achung des Fehlermodells mdglich. 

Denn dadurch wird eine Aufteilung des Fehlerzustandes des Positionsfilters in seinen Along-Track-Fehler, 
dem Along-Track-Positionsfehler und dem Weggeberskalenfaktorfehler 8SFdt, und seinem Cross-Track-Feh- 
ler, dem Cross-Track-Positionsfehler Spy, dem Azimutf ehler eo und den z-Kreiself ehler, dem Drif tfehler dz und 20 
dem Skalenf aktorf ehler SSFgz ermdglicht 

In der Fig. 4 ist die Fehlerschatzgleichung des Positionsfilters in kontinuierlicher Form, dargestellt, und zwar 
in der Form mit einem in eine fahrzeugfeste Darstellung transformierten Fehlerzustand Da der Fehlerzustand 
des Skalenfaktorfehlers des z-Kxeiseis fur die folgende Fehleranalyse vernachlassigbar ist, wurde dieser aus 
GrOnden der vereinfachten Darstellung nicht weiter berucksichtigt 25f 

In der Fig. 5 ist ein Gesamtf ehlermodeli fur eine Horizontalnavigation einer gestiltzten Koppelnavigation 
dargestellt Das Fehlermodell gem&B der Fig. 5 umfafit somit die nichtlinearen Navigationsalgorithmen in 
Verbindung mit dem auf einem linearen Modell basierenden Positionsfilter als Teilfilter des Kalman-Filters 24 
und der RQckfQhrung der Filterschatz werte als Korrektur in die Navigationsalgorithmen. 

Nachfolgend soil auf die Unterschiede der in den Fig. 4 und 5 dargestellten Fehlermodell e eingegangen 30 
werden. 

Bei dem in Fig. 4 gezeigten Fehlermodell sind die Fehlersch&tzwerte dargestellt, wahrend die in Fig. 5 
dargestellten Fehlerzustande den Gesamtfehler der berechneten Navigationsgrdfien gegenOber den tats&chli- 
chen NavigationsgrdBen beschreibt Das Fehlermodell gemaB Fig. 5 enthalt nichtlineare Bldcke des Azimutf eh- 
lers mit der Eigenschaft, daB fur kleine Azimutfehler by die Fehlerschatzgleichung gem&B Fig. 5 sich an die 35 
Struktur der Fehlerschatzgleichung gemaB Fig. 4 angleicht 

Die Analyse des Gesamtf ehlermodells gemaB der Fig. 5 zeigt dann Fehlfunktionen des Navigationssystems 10 
auf, wenn der Azimutfehler 8\y groBe Werte annimmt Einerseits kann bei groBen Werten fur den Azimutfehler 
5y grdBer 90° das Fehlermodell instabil werden, wahrend andererseits fiber die zusatzliche Kopplung zum 
Along-Track-Teilfilter des Positionsfilters fflr groBe Azimutfehler 8\jf der Weggeberskalenfaktor dekalibriert 40 
werden kann. Die Ursachen ffir einen Azimutfehler 8y kdnnen in einem groBen Ausgangsfehler 8y(0) liegen 
oder auch durch eine StQtzung mit einem sehr groBen Positions fehJer verursacht werden. Beide Fehlerursachen 
treten beispielsweise durch fehlerhafte Bngaben oder nach einem Transport des Fahrzeugs bei abgeschaltetem 
Navigationssystem 10 mit einer eventuellen automatischen GPS-Stutzung nach dem Wiedereinschalten auf, da 
f Or normale Betriebszust&nde immer das Navigationsergebnis vor dem letzten Abschalten gespeichert wird. 45 

Um die Dekalibration des Positionsfilters und damit des gesamten Navigationssystems 10 zu vermeiden, wird 
der Positionsfilter wahrend des durch eine Fahrt charakterisierten Betriebszustandes des Fahrzeugs in seinem 
linearen Arbeitsbereich Qberwacht Hierbei wird jede dem Positionsfilter zugefuhrte StQtzposition, wie die 
Fig. 4 und 5 zeigen, auf Piausibiiitat geprQft Nur bei Erfullung der Plausibiiitatsbedingungen wind die Positions- 
stUtzung durchgefQhrt Werden die Plausibiiitatsbedingungen nicht erfullt, wird das Navigationssystem 10 mit 50 
der Stiitzposition initialisiert und das Positionsfilter in einen definierten Status (Default-Status) versetzL 

Nach Einschalten des Navigationssystems 10 wird die erste Positionsstutzung zur Initialisierung verwendet 
und das Positionsfilter in den Default-Status versetzt Der Azimut wird hierbei grundsatzlich, auBer bei einer 
Azimuteingabe oder einer ICorrektur durch eine Azimutuberwachung, beibehalten. 

Die Azimutuberwachung kann derart erfolgen, daB neben der gestutzten Navigationsrechnung eine tinge- 55 
stiitzte Kontroilnavigation berechnet wird, die an jedem IControllpunkt mit der gestutzten Navigation abgegli- 
chen wird Die ungestutzte Kontroilnavigation wird mit einem unabhangig bestimmten Grobazimut verglichea 
Dieser Grobazimut kann beispielsweise Qber eine Triangulation mit zwei Referenzpunkten, die beispielsweise 
Qber den GPS-Empfanger 30 und/oder Kartenpunkte 32 bereitgestellt werden, bestimmt werden oder direkt als 
GPS-Azimut ausgelesen werden beziehungsweise aus der GPS-Geschwindigkeit bestimmt werden. 60 

Wenn die ermittelte Azimutabweichung hinreichend klein ist, kann die Navigationsrechnung fortgesetzt 
werdea Andernfalls wird die Navigation mit der Referenzposition dem Grobazimut initialisiert und das Posi- 
tionsfilter in den definierten Default-Status versetzt. Die Kontroilnavigation wird nach Abgleich mit der gestutz- 
ten Navigation nach jedem Kpntrollpunkt neu gestartet Der erwahnte Default-Status des Positionsfilters 
bewirkt, daB alle Sensorkalibrationswerte auf bestimmte gespeicherte, zuvor auf ihre Richtigkeit uberprOfte 65 
Werte zuruckgesetzt werdea Dies konnen sehr vorteilhaft Sensorkalibrationswerte sein, die bei der letzten 
durchgefuhrten Kontroilnavigation ermittelt wurden, die zu keiner Rucksetzung des Positionsfilters auf den 
Default-Status geftihrt habea Um eine ausreichende Lernfahigkeit des Positionsfilters zu erreichen, wird die 
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Kovarianzmatrix des Positionsf liters diag nalisiert und in der Hauptdiagonalen mit geeigneten Default-Werten 
besetzt 

Sehr vorteilhaft konnen fur die PlausibilitatsprOfung der Stutzp siti nen und der Azimut-Oberwachung 
statistische Fehlerbewertungsverfahren verwendet werden, die als Selbstdiagnose die im Kalman-Filter 24 
berechnete Kovarianzinf ormationen zu den FilterschatzgrdBen benutzen. 

Wurde bisher bei der Oberwachung des linearen Arbeitsbereiches des Positionsfilters von einem durch Fahrt 
gekennzeichneten Betriebszustand des Fahrzeugs ausgegangen, laBt sich das Positionsfilter auch so modiftzie- 
ren, daB sich die Oberwachung des linearen Arbeitsbereiches auch bei einem durch einen Stillstand gekennzeich- 
neten Betriebszustand des Fahrzeugs err ichen laBt Der durch den Stillstand gekennzeichnete Bewegungszu- 
stand des Fahrzeugs kann mittels eines Algorithmus identifiziert und Qberwacht werden, der durch eine Answer- 
tung der Sensoren des Navigationssystems ausgeldst wird Bei Erkennen des Stilistand-Zustands ergibt sich, daB 
die Position konstant ist, die Geschwindigkeit gleich Null ist und der Azimut ebenf alls konstant ist 

In der Fig. 6 wird eine modifizierte Signalverarbeitungsstruktur der gestOtzten Koppelnavigation gezeigt, die 
an den durch einen Stillstand des Fahrzeugs gekennzeichneten Zustand angepaBt ist Gleiche Teile wie in den 
vorhergehenden Figuren sind wiederum mit gleichen Bezugszeichen versehen und nicht nochmals erlautert 

Durch die erfolgte Definition des Sttllstandszustandes ist der Koppelkurs konstant Die von dem z-Kreisel 14 
bereitgestellten MeBsignaie werden als Fehlersignal interpretiert aus dtesem Grunde nicht mehr der Kurs-/La- 
gerechnung 20, sondern nur noch direkt als Beobachtung dem Kalraan-Filter 24 zugefuhrt Daruber hinaus ist 
durch den Stillstand des Fahrzeugs die von dem GPS-Empfanger 30 an sich bereitgestellte Geschwindigkeits- 
messung nicht mehr verfugbar. Fur Geratekonfigurationen, die (optional) einen nordsuchenden Kreisel als 
zusatzliche Baugruppe enthalten, kann im Stillstand der von der Koppelnavigation 18 bereitgestellte Azimut mit 
dem des nordsuchenden Kreisels 42 verglichen werden, so daB eine Azimut-Korrektur aus dem Koppelkurs und 
dem gelieferten MeBwert des nordsuchenden Kreisels 42 ermittelt und als Beobachtung auf das Kalman-Filter 
24 aufgeschaltet werden kann. 

Anhand der Fig. 7 wird die Auswirkung des durch den Stillstand gekennzeichneten Fahrzeugzustandes und 
der in Fig. 6 gezeigten strukturellen Modiftkation des Navigationsalgorithmus auf die Fehlerschatzgleichungen 
des Positionsfilters verdeutlicht Hierbei werden folgende Unterschiede zu den Fehlerschatzgleichungen gemaB 
den Fig. 4 und 5 deutlich. Durch den Stillstand des Fahrzeugs steht ein kontinuierlicher MeBwert des z-Kreisels 
14 als Filterbeobachtung zur Verf ugung, so daB im Stillstand eine kontinuierliche Schatzung der Kreiseldrift 
erfolgen kann. Bei der Verf Ugbarkeit von Positions- beziehungsweise Azimutmessungen konnen diese neben 
einer Verbesserung der zugehorigen SchatzgrdBen durch Mittelung auch eine Verbesserung der restlichen 
SchatzgrdBen zur Folge haben, da bei einem dem Stillstand vorausgegangenen ungestutzten Fahrtabschnitt 
Kreuzkorrelationen zwischen den einzelnen Fehlerzustanden aufgebaut werden konnen. 

Dar&ber hinaus kann durch eine Beibehaltung der Oberwachung der Positions- und Azimutstutzung, wie dies 
bei der Stgnalverarbeitung in dem durch Fahrt gekennzeichneten Fahrzeugzustand erfolgte, sichergestellt 
werden, daB das Positionsfilter nicht auBerhalb des zulassigen linearen Arbeitsbereiches betrieben wird. Im 
Unterschied zum Betriebszustand der Fahrt besteht jedoch im Betriebszustand des Stillstandes keine Notwen- 
digkeit, den Driftzustand und die zugehorige Korrelation in die Rucksetzung des Positionsfilters auf den 
Default-Status miteinzubeziehen. 

Insgesamt wird es also mdglich, indem die von dem z-Kreisel 14 gelieferten Signale bei Stillstand d s 
Fahrzeugs als direkte Beobachtung dem Kalman*Filter 24 aufgeschaltet werden, eine kontinuierliche Schatzung 
der Kreiseldrift im Stillstand durchzufuhren. Gleichzeitig wird durch den Erhalt der Struktur des Positionsfilters, 
wie in Fig. 7 gezeigt, sichergestellt, daB eine Positions- und/oder Azimutstutzung Korrekturen fur alle Fehlerzu- 
stande zur Folge haben konnen, wenn entsprechende Kreuzkorrelationen, zum Beispiel in einem vorhergehen- 
den ungestutzten Fahrtabschnitt, aufgebaut worden sind. 

Durch Beibehaltung der Positions- und Azimutuberwachung auch wahrend des Stillstandzustandes wird eine 
Dekalibration des Positionsfilters vermieden. Hierbei ist fur die Definition des bereits erlauterten Default-Status 
des Positionsfilters zu beachten, daB eine Dekalibration der Driftschatzung nicht mdglich ist und deshalb der 
Driftzustand mit zugehdriger Kovarianz aus der Rucksetzung auf den Default-Status im Stillstand auszunehmen 
ist 

Patentanspruche 

1. Navigationssystem fiir ein Fahrzeug, insbesondere fiir ein Landfahrzeug, mit wenigstens einem einachsi- 
gen Kreisel fur die Fahrzeughochachse (z-Achse), mit zwei Beschleunigungsmessern in der horizontalen 
Fahrzeugebene (x-Achse, y-Achse), einer fahrzeugfesten Geschwindigkeitsmessung mit einer Stiitzsignal- 
einrichtung, insbesondere einem Satellitenempfanger und/oder einer Karte, und mit einer Steuerung, die 
aus den gemessenen und gespeicherten Signalen mit Hilfe eines geeigneten Kalman-Filters die berechnete 
Fahrzeugposition und/oder die Fahrtrichtung korrigiert, dadurch gekennzeichnet, daB dem Kalman-Fiker 
(24) wenigstens ein Teilfilter zugeordnet ist, von denen ein erstes Teilfilter einer dynamischen Horizontie- 
rung dient und/oder ein zweites Teilfilter als Positionsfilter ausgebildet ist, das eine Kurs-, Positions- und 
Sensorkalibration bewirkt 

2. Navigationssystem nach Anspruch 1, dadurch gekennzeichnet, daB das Teilfilter der dynamischen Hbri- 
zontierung eine Drehratenschatzung in der fahrzeugfesten Horizontalebene durchfiihrt und diese quasikon- 
tinuierlich in das Navigationssystem (10)zuruckgefuhrt werden. 

3. Navigationssystem nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet, daB die Schatz- 
werte in einer der jeweiligen Anwendung angepaBten geeigneten Bandbreite zuruckgefuhrt werden. 

4. Navigationssystem nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet, daB eine Ruck- 
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ffihrung von den Drehratenschatzwerten aquivalenter Sch&tzwerte erfolgt 

5. Navigationssystem nach Anspruch 4, dadurch gekennzeichnet daB Schitzwerte der diskreten Winketin- 
kreracnte in den horizontalen Fahrzeugachsen (x- Achse, y- Achse) riickgef Qhrt werden. 

6. Navigationssystem nach einem der vorhergehenden Ansprttche, dadurch gekennzeichnet daB die Ord- 
nung des Teilfilters an eine Definition der Fehlerzustinde anpafibar ist 5 

7. Navigationssystem nach Anspruch 6, dadurch gekennzeichnet, daB das Teilfilter der dynamischen Hon- 
zontierung auf einem diskreten Fehlennodeli 6. Ordnung mit folgender Formulierung beruht 
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8. Navigationssystem nach einem der vorhergehenden AnsprGche, dadurch gekennzeichnet, daB das Teilfil- 
ter der dynamischen Horizontierung als zwei station&re Kalmanfilter 3. Ordnung dimensioniert ist, und 
Kopplungen zwischen den Teilfiltern 3. Ordnung bei der Realisierung als deterministische Eingangssignale 
berOcksichtigt werden. 

9. Navigationssystem nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet, daB das Teilfil- 
ter der dynamischen Horizontierung in den Kalman- Filter integriert ist 

10. Navigationssystem nach einem der vorhergehenden Ansprflche, dadurch gekennzeichnet, daB eine 
adaptive Dimensionietung des stochastischen Modells des Kalman-Filters, insbesondere eine frequenz- 
bandselektive Bewertung der translatorischen Stdrungen in den Beschleunigungsmessungen, erfolgt 

11. Navigationssystem nach einem der vorhergehenden AnsprQche, dadurch gekennzeichnet, daB bei dem 
als Positionsfilter ausgebildeten zweiten Teilfilter verwendete StQtzpositionen auf ihre Ptausibilitat Ober- 
pruft werden und bei nicht plausiblen Stutzpositionen eine Rucksetzung des Positionsfilters in einen 
definierten Status (Default-Status) mit gespeicherten, auf ihre Richtigkeit uberpriifte Sensorkalibrations- 
werte erfolgt 

12. Navigationssystem nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet, daB als uber- 
priifte Sensorkalibrationswerte die Werte der letzten Kontrollnavigation verwendet werden, die nicht zu 
einer Rucksetzung des Positionsfilters gef Qhrt haben. 

13. Navigationssystem nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet daB beim 
erstmaligen Einschalten des Positionsfilters dieser in den Default-Status versetzt wird 

14. Navigationssystem nach einem der vorhergehenden Ansprtiche, dadurch gekennzeichnet daB zusatzlich 
zu der Plausibilit&tsprufung der Stutzpositionen eine Azimutuberwachung erfolgt 

15. Navigationssystem nach Anspruch 14, dadurch gekennzeichnet daB neben der gestutzten Navigations- 
rechnung eine ungestutzte Kontrollnavigation berechnet wird, die an jedem Kontrollpunkt mit der gestutz- 
ten Navigationsrechnung abgeglichen wird 

16. Navigationssystem nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet daB fur die 
Plausibilitatsuberprufung und die Azimutuberwachung statistische Fehlerbewertungsverfahren verwendet 
werden, die als Selbstdiagnose die ira Kalman-FUter (24) berechnete Kovarianzinformationen in den Filter- 
schatzgroBen benutzen. 

17. Navigationssystem nach einem der vorhergehenden Anspruche, dadurch gekennzeichnet daB bei uber 
einen Algorithmus erkannten Stillstand des Fahrzeugs eine Umschaltung des Positionsfilters erfolgt wobei 
ein jetzt kontinuierlicher MeBwert eines z-Kreisels als Beobachtung auf den Kalman-Filter (24) geschaltet 
wird 
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